/********************************************************************************************************************
serial_to_drone.cpp

Author:SFL

Update Time: 2020.9.18

Introduction:  Send data to Serial
    


************************************************************************************************************************/


#include <ros/ros.h>
#include <serial_to_drone.h>

// extern uint8_t radioMsg[32];
// nh.param("SerialParam/port_name",port_name,"/dev/ttyUSB0");
// nh.param("SerialParam/baudrate", bandrate, 9600);
// nh.param("SerialParam/time_out", time_out, 1000)

// int serial_init()
// {
//     try 
//     {
//         ser.setPort("/dev/ttyUSB0");
//         ser.setBaudrate(9600);
//         serial::Timeout to = serial::Timeout::simpleTimeout(1000);
//         ser.setTimeout(to);
//         ser.open();
//     } 
//     catch (serial::IOException &e) 
//     {
//         ROS_ERROR_STREAM("Unable to open port ");
//         return 0;
//     }
 
//   if (ser.isOpen())
//    {
//         ROS_INFO_STREAM("Serial Port initialized");
//    } 
//    else 
//    {
//         return 0;
//    }
//    return 1;
// }

// int main(int argc, char *argv[])
// {
//     ros::init(argc, argv, "serial_to_drone");
//     ros::NodeHandle nh("~");
//     int serial_open = serial_init();

//     ros::Rate rate(2);
//     while (ros::ok())
//     {
//         ser.write(radioMsg,32);
//         rate.sleep();
//     }
    
//     return 0;
// }



















